#!/usr/bin/env python

import lcm
from mani_lcm_msgs import touch_point_msg

if __name__=="__main__":
  #rospy.init_node('socket_server')
  lc = lcm.LCM("udpm://239.255.76.67:7667?ttl=10")

  msg = touch_point_msg()

  msg.p= [0, 0.01, 0.01]
  msg.w= [0, 0, 0.157, 0]

  lc.publish("TOUCH_POINT", msg.encode())

  pass
